#include "PoseSolver.h"
#include "Parameter.h"

using namespace std;
using namespace cv;

float pi = 3.1415926;

int main(int argc, char *argv[])
{
    p_posesolver poseSolver = p_posesolver(new PoseSolver());
    Mat depth = imread("../Temp/dep.png", IMREAD_UNCHANGED);
    Mat rgb = imread("../Temp/rgb.png");
}